/**
  ******************************************************************************
  * @file    main.c
  * @author  MCU Application Team
  * @brief   Main program body
  ******************************************************************************
  * @attention
  *
  * <h2><center>&copy; Copyright (c) 2023 Puya Semiconductor Co.
  * All rights reserved.</center></h2>
  *
  * This software component is licensed by Puya under BSD 3-Clause license,
  * the "License"; You may not use this file except in compliance with the
  * License. You may obtain a copy of the License at:
  *                        opensource.org/licenses/BSD-3-Clause
  *
  ******************************************************************************
  * @attention
  *
  * <h2><center>&copy; Copyright (c) 2016 STMicroelectronics.
  * All rights reserved.</center></h2>
  *
  * This software component is licensed by ST under BSD 3-Clause license,
  * the "License"; You may not use this file except in compliance with the
  * License. You may obtain a copy of the License at:
  *                        opensource.org/licenses/BSD-3-Clause
  *
  ******************************************************************************
  */

/* Includes ------------------------------------------------------------------*/
#include "main.h"
#include "py32md420xx_ll_Start_Kit.h"

/* Private define ------------------------------------------------------------*/
/* Private variables ---------------------------------------------------------*/
__IO int32_t arcResult = 0;
__IO int32_t modResult = 0;
  
/* Private user code ---------------------------------------------------------*/
/* Private macro -------------------------------------------------------------*/
#define PI         3.14159265358979323846
#define Y_VALUE    0.25
#define X_VALUE    0.25
#define POWER_2_31 2147483648.0  /* To the 31st power of 2 */
#define K          0.607252935008883

/* Private function prototypes -----------------------------------------------*/
static void APP_SystemClockConfig(void);
static void APP_ConfigCordic(void);

/**
  * @brief  Main program.
  * @param  None
  * @retval int
  */
int main(void)
{
  /* Enable SYSCFG and PWR clock */
  LL_APB1_GRP2_EnableClock(LL_APB1_GRP2_PERIPH_SYSCFG);
  LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_PWR);

  /* Configure system clock */
  APP_SystemClockConfig();

  /* Initialize USART (for printf use) */
  BSP_USART_Config();

  /* Configure CORDIC */
  APP_ConfigCordic();
  
  /* Set input Y、X */
  LL_CORDIC_SetCoordinateY(CORDIC, (int32_t)((Y_VALUE / PI) * POWER_2_31));
  LL_CORDIC_SetCoordinateX(CORDIC, (int32_t)((X_VALUE / PI) * POWER_2_31));

  /* Start calculation */
  LL_CORDIC_SetStart(CORDIC);

  while (1)
  {
    
  }
}

/**
  * @brief  Configure CORDIC.
  * @param  None
  * @retval None
  */
static void APP_ConfigCordic(void)
{
  /* Enable CORDIC clock */
  LL_AHB1_GRP1_EnableClock(LL_AHB1_GRP1_PERIPH_CORDIC);
  
  /* Set iterations */
  LL_CORDIC_SetIterations(CORDIC, 24);
  
  /* Set function */
  LL_CORDIC_SetFunction(CORDIC, LL_CORDIC_FUNCTION_ARCTAN_MOD);
  
  /* Set start mode */
  LL_CORDIC_SetStartMode(CORDIC, LL_CORDIC_STARTMODE_NOT_AUTO);
  
  /* Set Arctan and Mod InOutSize data width */
  LL_CORDIC_SetArctanModInOutSize(CORDIC, LL_CORDIC_ARCTAN_MOD_IN_OUT_SIZE_NOT_24BITS);
  
  /* Set input data width */
  LL_CORDIC_SetInSize(CORDIC, LL_CORDIC_INSIZE_32BITS);
  
  /* Set output data width */
  LL_CORDIC_SetOutSize(CORDIC, LL_CORDIC_OUTSIZE_32BITS);
  
  /* Enable NVIC Interrupt */
  NVIC_SetPriority(CORDIC_IRQn, 0);
  NVIC_EnableIRQ(CORDIC_IRQn);
  
  /* Enable CORDIC Interrupt */
  LL_CORDIC_EnableIT_CORDIC(CORDIC);
  LL_CORDIC_EnableIntMask_CORDIC(CORDIC);
  LL_CORDIC_EnableIntMask_CORDIC_ERROR(CORDIC);
  LL_CORDIC_EnableIntMask_ARCTAN_MOD_OV(CORDIC);
}

/**
  * @brief  CORDIC interrupt callback function
  * @param  None
  * @retval None
  */
void APP_CordicIRQCallback(void)
{
  if (LL_CORDIC_IsEnabledIT_CORDIC(CORDIC) == 1)
  {
    if ((LL_CORDIC_IsActiveFlag_CCFF(CORDIC) == 1) && (LL_CORDIC_IsEnabledIntMask_CORDIC(CORDIC) == 1))
    {
      LL_CORDIC_ClearFlag_CCFF(CORDIC);
      
      arcResult = LL_CORDIC_GetArctan(CORDIC);
      modResult = LL_CORDIC_GetMod(CORDIC);
      
     printf("arctan value = %lf\r\n", ((arcResult / POWER_2_31) * PI));
     printf("mod value = %lf\r\n", ((modResult / POWER_2_31) * PI) * K);
    }
    
    if ((LL_CORDIC_IsActiveFlag_CCEF(CORDIC) == 1) && (LL_CORDIC_IsEnabledIntMask_CORDIC_ERROR(CORDIC) == 1))
    {
      LL_CORDIC_ClearFlag_CCEF(CORDIC);
      printf("When CORDIC is busy, write data to CORDIC\r\n");
    }
    
    if ((LL_CORDIC_IsActiveFlag_ACEF(CORDIC) == 1) && (LL_CORDIC_IsEnabledIntMask_ARCTAN_MOD_OV(CORDIC) == 1))
    {
      LL_CORDIC_ClearFlag_ACEF(CORDIC);
      printf("Calculate overflow\r\n");
    }
  }
}

/**
  * @brief  Configure system clock
  * @param  None
  * @retval None
  */
static void APP_SystemClockConfig(void)
{
  /* Enable HSI */
  LL_RCC_HSI_Enable();
  while(LL_RCC_HSI_IsReady() != 1)
  {
  }

  /* Set AHB prescaler: HCLK = SYSCLK */
  LL_RCC_SetAHBPrescaler(LL_RCC_SYSCLK_DIV_1);

  /* Select HSISYS as system clock source */
  LL_RCC_SetSysClkSource(LL_RCC_SYS_CLKSOURCE_HSISYS);
  while(LL_RCC_GetSysClkSource() != LL_RCC_SYS_CLKSOURCE_STATUS_HSISYS)
  {
  }

  /* Set APB prescaler: PCLK = HCLK */
  LL_RCC_SetAPB1Prescaler(LL_RCC_APB1_DIV_1);
  LL_Init1msTick(8000000);

  /* Update the SystemCoreClock global variable(which can be updated also through SystemCoreClockUpdate function) */
  LL_SetSystemCoreClock(8000000);
}

/**
  * @brief  Error executing function.
  * @param  None
  * @retval None
  */
void APP_ErrorHandler(void)
{
  while (1)
  {
  }
}

#ifdef  USE_FULL_ASSERT
/**
  * @brief  Reports the name of the source file and the source line number
  *         where the assert_param error has occurred.
  * @param  file: pointer to the source file name
  * @param  line: assert_param error line source number
  * @retval None
  */
void assert_failed(uint8_t *file, uint32_t line)
{
  /* Users can add their own printing information as needed,
     for example: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  /* Infinite loop */
  while (1)
  {
  }
}
#endif /* USE_FULL_ASSERT */

/************************ (C) COPYRIGHT Puya *****END OF FILE******************/
